/*
 * SPDX-FileCopyrightText: 2021-2022 Espressif Systems (Shanghai) CO LTD
 *
 * SPDX-License-Identifier: Apache-2.0
 */

#include <stdlib.h>
#include <sys/cdefs.h>
#include "sdkconfig.h"
#if CONFIG_LCD_ENABLE_DEBUG_LOG
// The local log level must be defined before including esp_log.h
// Set the maximum log level for this source file
#define LOG_LOCAL_LEVEL ESP_LOG_DEBUG
#endif
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "esp_lcd_panel_interface.h"
#include "esp_lcd_panel_io.h"
#include "esp_lcd_panel_vendor.h"
#include "esp_lcd_panel_ops.h"
#include "esp_lcd_panel_commands.h"
#include "driver/gpio.h"
#include "esp_log.h"
#include "esp_check.h"

static const char *TAG = "lcd_panel.st7796s";

static esp_err_t panel_st7796s_del(esp_lcd_panel_t *panel);
static esp_err_t panel_st7796s_reset(esp_lcd_panel_t *panel);
static esp_err_t panel_st7796s_init(esp_lcd_panel_t *panel);
static esp_err_t panel_st7796s_draw_bitmap(esp_lcd_panel_t *panel, int x_start, int y_start, int x_end, int y_end, const void *color_data);
static esp_err_t panel_st7796s_invert_color(esp_lcd_panel_t *panel, bool invert_color_data);
static esp_err_t panel_st7796s_mirror(esp_lcd_panel_t *panel, bool mirror_x, bool mirror_y);
static esp_err_t panel_st7796s_swap_xy(esp_lcd_panel_t *panel, bool swap_axes);
static esp_err_t panel_st7796s_set_gap(esp_lcd_panel_t *panel, int x_gap, int y_gap);
static esp_err_t panel_st7796s_disp_on_off(esp_lcd_panel_t *panel, bool off);

typedef struct
{
    esp_lcd_panel_t base;
    esp_lcd_panel_io_handle_t io;
    int reset_gpio_num;
    bool reset_level;
    int x_gap;
    int y_gap;
    unsigned int bits_per_pixel;
    uint8_t madctl_val; // save current value of LCD_CMD_MADCTL register
    uint8_t colmod_cal; // save surrent value of LCD_CMD_COLMOD register
} st7796s_panel_t;

esp_err_t esp_lcd_new_panel_st7796s(const esp_lcd_panel_io_handle_t io, const esp_lcd_panel_dev_config_t *panel_dev_config, esp_lcd_panel_handle_t *ret_panel)
{
#if CONFIG_LCD_ENABLE_DEBUG_LOG
    esp_log_level_set(TAG, ESP_LOG_DEBUG);
#endif
    esp_err_t ret = ESP_OK;
    st7796s_panel_t *st7796s = NULL;
    ESP_GOTO_ON_FALSE(io && panel_dev_config && ret_panel, ESP_ERR_INVALID_ARG, err, TAG, "invalid argument");
    st7796s = calloc(1, sizeof(st7796s_panel_t));
    ESP_GOTO_ON_FALSE(st7796s, ESP_ERR_NO_MEM, err, TAG, "no mem for st7796s panel");

    if (panel_dev_config->reset_gpio_num >= 0)
    {
        gpio_config_t io_conf = {
            .mode = GPIO_MODE_OUTPUT,
            .pin_bit_mask = 1ULL << panel_dev_config->reset_gpio_num,
        };
        ESP_GOTO_ON_ERROR(gpio_config(&io_conf), err, TAG, "configure GPIO for RST line failed");
    }

    switch (panel_dev_config->color_space)
    {
    case ESP_LCD_COLOR_SPACE_RGB:
        st7796s->madctl_val = 0;
        break;
    case ESP_LCD_COLOR_SPACE_BGR:
        st7796s->madctl_val |= LCD_CMD_BGR_BIT;
        break;
    default:
        ESP_GOTO_ON_FALSE(false, ESP_ERR_NOT_SUPPORTED, err, TAG, "unsupported color space");
        break;
    }

    switch (panel_dev_config->bits_per_pixel)
    {
    case 16:
        st7796s->colmod_cal = 0x55;
        break;
    case 18:
        st7796s->colmod_cal = 0x66;
        break;
    case 24:
        st7796s->colmod_cal = 0x57;
        break;
    default:
        ESP_GOTO_ON_FALSE(false, ESP_ERR_NOT_SUPPORTED, err, TAG, "unsupported pixel width");
        break;
    }

    st7796s->io = io;
    st7796s->bits_per_pixel = panel_dev_config->bits_per_pixel;
    st7796s->reset_gpio_num = panel_dev_config->reset_gpio_num;
    st7796s->reset_level = panel_dev_config->flags.reset_active_high;
    st7796s->base.del = panel_st7796s_del;
    st7796s->base.reset = panel_st7796s_reset;
    st7796s->base.init = panel_st7796s_init;
    st7796s->base.draw_bitmap = panel_st7796s_draw_bitmap;
    st7796s->base.invert_color = panel_st7796s_invert_color;
    st7796s->base.set_gap = panel_st7796s_set_gap;
    st7796s->base.mirror = panel_st7796s_mirror;
    st7796s->base.swap_xy = panel_st7796s_swap_xy;
    st7796s->base.disp_on_off = panel_st7796s_disp_on_off;
    *ret_panel = &(st7796s->base);
    ESP_LOGD(TAG, "new st7796s panel @%p", st7796s);

    return ESP_OK;

err:
    if (st7796s)
    {
        if (panel_dev_config->reset_gpio_num >= 0)
        {
            gpio_reset_pin(panel_dev_config->reset_gpio_num);
        }
        free(st7796s);
    }
    return ret;
}

static esp_err_t panel_st7796s_del(esp_lcd_panel_t *panel)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);

    if (st7796s->reset_gpio_num >= 0)
    {
        gpio_reset_pin(st7796s->reset_gpio_num);
    }
    ESP_LOGD(TAG, "del st7796s panel @%p", st7796s);
    free(st7796s);
    return ESP_OK;
}

static esp_err_t panel_st7796s_reset(esp_lcd_panel_t *panel)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;

    // perform hardware reset
    if (st7796s->reset_gpio_num >= 0)
    {
        gpio_set_level(st7796s->reset_gpio_num, st7796s->reset_level);
        vTaskDelay(pdMS_TO_TICKS(10));
        gpio_set_level(st7796s->reset_gpio_num, !st7796s->reset_level);
        vTaskDelay(pdMS_TO_TICKS(10));
    }
    else
    { // perform software reset
        esp_lcd_panel_io_tx_param(io, LCD_CMD_SWRESET, NULL, 0);
        vTaskDelay(pdMS_TO_TICKS(20)); // spec, wait at least 5m before sending new command
    }

    return ESP_OK;
}

static esp_err_t panel_st7796s_init(esp_lcd_panel_t *panel)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;
    // LCD goes into sleep mode and display will be turned off after power on reset, exit sleep mode first
    esp_lcd_panel_io_tx_param(io, LCD_CMD_SLPOUT, NULL, 0);
    vTaskDelay(pdMS_TO_TICKS(100));
    // enable command 2 part I
    esp_lcd_panel_io_tx_param(io, 0xf0, (uint8_t[]){0xc3}, 1);
    // 96h enable command 2 part II
    esp_lcd_panel_io_tx_param(io, 0xf0, (uint8_t[]){0x96}, 1);
    // 显示设置
    esp_lcd_panel_io_tx_param(io, LCD_CMD_MADCTL, (uint8_t[]){
                                                      st7796s->madctl_val,
                                                  },
                              1);
    esp_lcd_panel_io_tx_param(io, LCD_CMD_COLMOD, (uint8_t[]){
                                                      st7796s->colmod_cal,
                                                  },
                              1);

    // 厂商参数,按初始化代码调整
    // 9.3.22 DOCA (E8h): Display Output Ctrl Adjust
    esp_lcd_panel_io_tx_param(io, 0xe8, (uint8_t[]){0x40, 0x82, 0x07, 0x18, 0x27, 0x0a, 0xb6, 0x33}, 8);
    // 9.3.12 VCMPCTL(C5h): VCOM Control
    esp_lcd_panel_io_tx_param(io, 0xc5, (uint8_t[]){0x27}, 1);
    // 9.3.11 PWR3 (C2h): Power Control 3
    esp_lcd_panel_io_tx_param(io, 0xc2, (uint8_t[]){0xa7}, 1);
    // 9.3.18 PGC (E0h): Positive Gamma Control
    esp_lcd_panel_io_tx_param(io, 0xe0, (uint8_t[]){0xf0, 0x01, 0x06, 0x0f, 0x12, 0x1d, 0x36, //
                                                    0x54, 0x44, 0x0c, 0x18, 0x16, 0x13, 0x15},
                              14);
    // 9.3.19 NGC (E1h): Negative Gamma Control
    esp_lcd_panel_io_tx_param(io, 0xe1, (uint8_t[]){0xf0, 0x01, 0x05, 0x0a, 0x0b, 0x07, 0x32, //
                                                    0x44, 0x44, 0x0c, 0x18, 0x17, 0x13, 0x16},
                              14);

    // disable command 2
    esp_lcd_panel_io_tx_param(io, 0xf0, (uint8_t[]){0x3c}, 1);
    esp_lcd_panel_io_tx_param(io, 0xf0, (uint8_t[]){0x69}, 1);
    return ESP_OK;
}

static esp_err_t panel_st7796s_draw_bitmap(esp_lcd_panel_t *panel, int x_start, int y_start, int x_end, int y_end, const void *color_data)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    assert((x_start < x_end) && (y_start < y_end) && "start position must be smaller than end position");
    esp_lcd_panel_io_handle_t io = st7796s->io;

    x_start += st7796s->x_gap;
    x_end += st7796s->x_gap;
    y_start += st7796s->y_gap;
    y_end += st7796s->y_gap;

    // define an area of frame memory where MCU can access
    esp_lcd_panel_io_tx_param(io, LCD_CMD_CASET, (uint8_t[]){
                                                     (x_start >> 8) & 0xFF,
                                                     x_start & 0xFF,
                                                     ((x_end - 1) >> 8) & 0xFF,
                                                     (x_end - 1) & 0xFF,
                                                 },
                              4);
    esp_lcd_panel_io_tx_param(io, LCD_CMD_RASET, (uint8_t[]){
                                                     (y_start >> 8) & 0xFF,
                                                     y_start & 0xFF,
                                                     ((y_end - 1) >> 8) & 0xFF,
                                                     (y_end - 1) & 0xFF,
                                                 },
                              4);
    // transfer frame buffer
    size_t len = (x_end - x_start) * (y_end - y_start) * st7796s->bits_per_pixel / 8;
    esp_lcd_panel_io_tx_color(io, LCD_CMD_RAMWR, color_data, len);

    return ESP_OK;
}

static esp_err_t panel_st7796s_invert_color(esp_lcd_panel_t *panel, bool invert_color_data)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;
    int command = 0;
    if (invert_color_data)
    {
        command = LCD_CMD_INVON;
    }
    else
    {
        command = LCD_CMD_INVOFF;
    }
    esp_lcd_panel_io_tx_param(io, command, NULL, 0);
    return ESP_OK;
}

static esp_err_t panel_st7796s_mirror(esp_lcd_panel_t *panel, bool mirror_x, bool mirror_y)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;
    if (mirror_x)
    {
        st7796s->madctl_val |= LCD_CMD_MX_BIT;
    }
    else
    {
        st7796s->madctl_val &= ~LCD_CMD_MX_BIT;
    }
    if (mirror_y)
    {
        st7796s->madctl_val |= LCD_CMD_MY_BIT;
    }
    else
    {
        st7796s->madctl_val &= ~LCD_CMD_MY_BIT;
    }
    esp_lcd_panel_io_tx_param(io, LCD_CMD_MADCTL, (uint8_t[]){st7796s->madctl_val}, 1);
    return ESP_OK;
}

static esp_err_t panel_st7796s_swap_xy(esp_lcd_panel_t *panel, bool swap_axes)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;
    if (swap_axes)
    {
        st7796s->madctl_val |= LCD_CMD_MV_BIT;
    }
    else
    {
        st7796s->madctl_val &= ~LCD_CMD_MV_BIT;
    }
    esp_lcd_panel_io_tx_param(io, LCD_CMD_MADCTL, (uint8_t[]){st7796s->madctl_val}, 1);
    return ESP_OK;
}

static esp_err_t panel_st7796s_set_gap(esp_lcd_panel_t *panel, int x_gap, int y_gap)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    st7796s->x_gap = x_gap;
    st7796s->y_gap = y_gap;
    return ESP_OK;
}

static esp_err_t panel_st7796s_disp_on_off(esp_lcd_panel_t *panel, bool on_off)
{
    st7796s_panel_t *st7796s = __containerof(panel, st7796s_panel_t, base);
    esp_lcd_panel_io_handle_t io = st7796s->io;
    int command = 0;
    if (on_off)
    {
        command = LCD_CMD_DISPON;
    }
    else
    {
        command = LCD_CMD_DISPOFF;
    }
    esp_lcd_panel_io_tx_param(io, command, NULL, 0);
    return ESP_OK;
}
